COMMENT ⊗   VALID 00004 PAGES
C REC  PAGE   DESCRIPTION
C00001 00001
C00002 00002	.TITLE CALIB
C00003 00003	CONVERSION FACTORS FOR ADC'S AND DAC'S
C00005 00004	KINEMATIC ARM CONSTANTS
C00008 ENDMK
C⊗;
.TITLE CALIB

;CALIBRATION DATA FOR THE NRL/SCHEINMAN ARM

;CURRENT VERSION OF ARM CODE/CALIBRATION DATA

HELLO:	.BYTE	15,12
	.ASCII	/ARM CONTROL PROGRAM, VERSION B, 28AUG76/
	.BYTE	15,12,0
	.EVEN
;CONVERSION FACTORS FOR ADC'S AND DAC'S

SCALE:	.WORD	32357.	;SCALE FACTOR FROM ADC TO ANGLES
	.WORD	31881.
	.WORD	-32002.
	.WORD	31462.
	.WORD	23149.
	.WORD	-31556.
	.WORD	5836.

OFFSET:	.WORD	-14022.	;JOINT OFFSETS
	.WORD	-24416.
	.WORD	24306.
	.WORD	-23919.
	.WORD	-11781.
	.WORD	12838.
	.WORD	-2181.

BSCALE:	.WORD	16501.	;S.F. FROM JT. ANG. TO DAC UNITS
	.WORD	16984.
	.WORD	-16852.
	.WORD	17868.
	.WORD	23088.
	.WORD	-17039.
	.WORD	22846.

BOFFST:	.WORD	2208.	;DAC OFFSET
	.WORD	-8417.
	.WORD	8262.
	.WORD	-8127.
	.WORD	-175.
	.WORD	-2982. 
	.WORD	750.

BSHIFT:	-1		;SHIFT COUNT TO CONVERT FROM ANGLE TO DAC
	-1
	-1
	-1
	-1
	-1
	1
;KINEMATIC ARM CONSTANTS

BASEX:	.WORD	0		;X & Y COORDINATE OF BASE
BASEY:	.WORD	0
S1:	.WORD	25424 		;10.77	OFFSET OF LINK 1
A2:	.WORD	20000 		;8.0	LENGTH OF LINK 2
S2S3:	.WORD	11256 		;4.67	OFFSET OF LINK 2 + OFFSET OF LINK 3
S2S3S:	.WORD	534		;21.81	(S2+S3)**2, DOUBLE PREC
	.WORD	167104
S4:	.WORD	20000		;8.0	OFFSET OF LINK 4
S6:  	.WORD	14000		;6.00	OFFSET OF LINK 6
S6S:	.WORD	60000 		;24.0	4*S6
S4A2S:	.WORD	4000		;128.0	S4**2 + A2**2
	.WORD	0
A2DS4:	.WORD	40000		;1.0	A2/S4
A224:	.WORD	10000		;256.0	4*A2↑2
	.WORD	0


;JOINT STOP LIMITS

LSTOP:	.WORD	 -12288.;-135 LOWER JOINT STOP LIMIT
	.WORD	 -22300.;-245
	.WORD	 -5006.	;-55
	.WORD	 -21390.;-235
	.WORD	 -9739.	;-107
	.WORD	 -15474.;-170
LHAND:	.WORD	 -31.	;-.03

USTOP:	.WORD 	 16839.	;185  UPPER JOINT STOP LIMIT
	.WORD	  5461.	;60
	.WORD	 19570.	;215
	.WORD	  5461.	;60
	.WORD	  9739.	;107
	.WORD	 10012. ;110
UHAND:	.WORD	  1946.	;1.9

MIDANG:	.WORD	  2276.	;25   MID POINT BETWEEN UPPER AND LOWER
	.WORD	 -7737.	;-85
	.WORD	  6827.	;75
	.WORD	 -7737.	;-85
	.WORD	     0.	;0
	.WORD	 -2731.	;-30
	.WORD	     0. ;0


;AVERAGE JOINT SPEEDS, USED FOR DETERMINING THE TIME REQUIRED
;TO EXECUTE A MOTION.

SPEEDS:	750.	; 96 DEG/SEC
	750.	; 96 DEG/SEC
	750.	; 96 DEG/SEC
	250.	;288 DEG/SEC
	250.	;288 DEG/SEC
	150.	;480 DEG/SEC

EXTIME:	15.	;A LITTLE EXTRA TIME FOR SHORT MOTIONS

PULTME:	10.	;DURATION OF HAND PULSE MODE